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ABSTRACT 



Compliant morion occurs when the manipulator position is constrained by 
the task geometry. Compliant motion ma* be produced either by a passive 
mechanical compliance built in to the manipulator, or by an active compliance 
implemented in the control servo loop. The second method, called force control, 
is the subject oF this report. In particular, this report presents a theory of force 
control based on formal models of the manipulator and the taslc geometry. The 
ideal fflbttot is used to model the manipulator, and the task geometry is modeled 
by the ideal surface, which is the locus of all positions accessible to the- ideal 
effector. Models are also defined for the goat trajectory, position control, and 
force Control. 

These models are useful in two respects. First* the model of force control 
provides a precise semantic* for force control primitives in manipulator 
programming tangles. The model defines a simple interface between the 
manipulator and the programmer, isolating the programmer from the fundamental 
complexity of low-level manipulator control, 

Second, the formalism provide* a method of synthesizing force control 
programs for compliant motion, A force control program is modeled as a set of 
equal ions in the components of manipulator velocity (angular velocity) and force 
(torque). The task geometry constraints can be modeled similarly. The control 
program synthesis problem is to construct a program whose equations, when 
combined with the task geometry equal ions, have a angle unique solution equal 
to the goal trajectory. We show that to obtain &ood performance in the presence 
of planning model error, it is also desirable that these two sets of equations be 
orthogonal and non-redundant. 
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i. Introduction 

M Overview and Motivation 

A computer-controiled mechanical manipulator is a tool of fantastic 
potential, but so far the applications have been disappointing both in number and 
in sophistication. Current applications of industrial manipulators; are for the most 
part limited to large-motion Tasks such as material transfer, spray-painting, and 
spot-welding. These operations are. accomplished by moving along a pre-defined 
sequence of points without any variation from one cycle to the next- This 
method is effective in many cases, but a variety of potential applications, notably 
automatic assembly, require more sophisticated use of the manipulator. 
Successful development of such applications awaits progress in several aspects of 
manipulation including compliant motion manipulator programming languages* 
and automated task planning. This report will focus on the first of these, 
compliant motion, 

"Compliant motion" occurs when the position of the manipulator is 
constrained by the task. When sliding along, a tabletop, for instance, downward 
motion of the manipulator is prevented. Another example is the opening of a 
drawer, where no rotation is possible and translation is possible only along the 
drawer's axis, Compliant motion is an important part of a mechanical assembly 
system* since fitting parts together generally requires motion between objects in 
contact. Ideally these operations should be performed quietly but without 
producing excessive forces at points of contact. 

There are two primary methods for producing compliant motion: a passive 
mechanical compliance built in to the manipulator or an active compliance 
implemented in the software control loop, force control . Passive compliance 
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offers some performance advantages, but the force control method offers the 
advantage of program inability. This allows the manipulator to choose the 
particular form of compliance necessary for the particular application. Using 
force control a single manipulator can both open a drawer and slide on n 

tablctop without pausing to change hands. 

Various force control systems have been implemented,, but development of 
an underlying theory of these systems has been neglected- This report approaches 
such a theory by construe) ing models of force control and of manipulator task 
geometry. These models can be useful in two ways. First, a force control system 
Can be evaluated according to how well it agrees with the formal model This is 
common in the case of position control, where a control system is judged by its 
"error" — the dEfference between the desired and actual trajectories. Second, a 
formal model greatly simplifies manipulator programming. Effective programming 
occurs only when the programmer has a thorough understanding -of the 
programming language primitives. Hence, the relevant primitives should be 
well-defined, which in the case of compliant motion primitives requires a mode) 
of force Control- 

1.2 Position and Force Control 

The development of a model for general force control is conveniently 

approached by discussing models for simpler control modes, pure position control 
and pure f orce control . The model for a general force control system will be 
intermediate between these two. 

Pure position control is a transducer whose input is in symbolic form and 
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whose output is encoded as the position and orientation 1 of the end-effector in 
some predetermined coordinate system. Input and output are just different 
encodings of the same six-dimensional vector function of time n(t). In pure 
position control the user is allowed to completely specify the effector position 
trajectory, Pure force control Can be defined In an analogous way — the user 
provides a vector function f{t) which specifier the force* to be exerted by the end 
effector. 

Each of these models is appropriate only under particular conditions, which 
can be deduced from simple mechanical considerations. For example, if pure 
position control is applied to the problem of sliding a drawer, then the position 
of the end-effector is subject to constraints from the task configuration and from 
the control system simultaneously. Due to the inevitable errors to manipulator 
planning and control, it is unlikely that these simultaneous constraints will be 
consistent. Our model of pure position control will not be satisfied in such a 
case, for the manipulator will not be free to follow the desired trajectory. 

This situ a I ion is illustrated by considering the Conceptual extremes. If the 
manipulator tip is buried in an immobile stiff solid substance, then there is no 
positional freedom at all, and pure position control is meaningless.. However, the 
manipulator will have complete forte freedom, since any force it wishes to exert 
will be "atccpied" by the solid. In this instance, pure force control of the 
manipulator is appropriate. Now consider the opposite extreme, with the 
manipulator in free space. The situation is completely reversed. There is no 
force freedom, because there is no possible source of the required! reactive force. 
Since there is no constraint on manipulator position, pure position control is now 

1. From now on the terra "positron" may be used to refer to both position and 
orientation. Likewise "force" may refer to both force and torque. 
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indicated. It appears that pure position and pure force control are in some sense 
dual concepts, and that the historical emphasis on position control is. the natural 
result of applications which involve v^y little physical contact. 

Intermediate between the extremes of solid space and free space axe 

surfa ces. Loosely speaking, a surface is a task configuration which allows only 
partial positional freedom. Freedom of motion occurs along surface tangents, 
while freedom of force occurs along surface normals. Neither pure position nor 
pure force control is appropriate in this Case, but rather a hybrid mode of 

control, which gives control of effector force along the surface normal and 
control of effector position along the surface tangent. 

To relate these issues to real-world manipulator control systems, consider 
the task of manipulating a round peg in a. hole (figure 1,1). The peg*s motion is 
constrained by the hole. Assuming a snug fit, the peg can rotate about its own 
axis or translate up or down along, the axis. If a position control system is in use, 
the motion of the peg and the force everted between the peg and hole are 
unpredictable. Any molion commands are very unlikely to satisfy the physical 
constraints, for the program's model of the task will inevitably contain some 
error N however slight. The effect depends critically on the details of the control 
servo and. on the presence of mechanical compliance in the manipulator. In some 
cases the inconsistency between the program constraints and the task constraints 
will produce large forces between the peg and hole, ultimately disturbing the task 
configuration or even damaging the manipulator. 

If the program may use force and position control simultaneously, the 

insertion becomes feasible. The program may specify that the forces and torques 
normal to the surface be zero during the motion. The control system can satisfy 
such a command only by producing small corrective motions that compensate for 
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Figure 1,1. Insertion of a Peg in a Hole. 



the inaccuracies of the position commands [koiie74]. 

1.3 Control Strategies and Programming Language Primitives 

Programming is often simplified by constructing the program hierarchical \y, 
with code at each level written using primitives defined at a lower level, For 
manipulator programming, the lowest level provides the interface with the 
manipulator sensors and actuators. Each primitive at this level constitutes a 
control strategy, i.e. a particular convention for combining input from higher level 
code and from sensors to produce signals for the actuators With every control 
strategy is. associated a set of assumptions, on the task configuration, and a 
particular function, often formulated as some aspect of the manipulator's behavior 
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to be regulated. TVe have already seen two examples of control strategies — 
pure position Control and puce force Control, The assumptions associated with 
these con mi I strategies were the absence of physical contact and the presence of 
it, respectively. 

Another control strategy in common use is the guarded move |Will75], 
which is- used to approach and touch a surface without producing excessive force 
after contact is made. This is achieved by moving toward the surface slowly 
while closely monitoring a sensor which can detect contact. Guarded move 
control strategies, and compliant motion control strategic* are complementary, if 
the two classes are suitably generalized. In chapter two we will present a formal 
definition of surface which includes solid space or free space as well as the locus 
of possible positions of a drawer or of a peg in hole. Compliant motion occurs 
when the manipulator trajectory traverses such a surface, and a guarded move 
occurs when the manipulator trajectory crosses the junction between two such 
surfaces. Hence a manipulator trajectory can be decomposed into ft sequence of 
compliant motions joined together by guarded moves. 

The use of control strategies provides a convenient structure for the 
low-level control system without unduly compromising flexibility. In addition, the 

task state assumptions can be "compiled" into the control strategy to produce a 
very efficient program. Since each control strategy is used for a particular 
manipulator function and a particular type of task Configuration, the control 
strategics must be switched in and out of the control loop by a higher-level 

process. 

There are three primary criteria for a useful control strategy. First, of 
course, is that its function be relevant to the task, Second is that it execute 
quickly, since it is generally executed at least twenty times per second Third, 
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the resulting behavior of the manipulator must be conceptually simple. This is 
important from a planning and modeling viewpoint In many respects the 
behavior of the manipulator itself wtEl be the most difficult component of the 
task configuration to model, due to iis great versatility. The rok of the control 
strategy is to mask this complexity from higher levels of code The control 
strategy model is the semantic component of a primitive of the manipulator 
programming language. Hence there are two character] miens of the problems 
addressed in this report; the synthesis of control strategies for compliant motion; 
and development of semantics of force control primitives for a manipulator 
programming language, 

1.4 Example and Overview of Control Strategy Synthesis 

Consider again the problem of manipulating a peg in a hole {figure U). A 
program for this task might look like 

MOVE TO D WITH 
BEGIN 

FORCE X 
FORCE Y 
TORQUE X 
TORQUE Y 
END 

where D is the goal posiiion of the peg The Coordinate aaes specified by force 
(torque) statements are the co mpliant ases* translation and rotation of k and y id 
some pre-determined cartes! an coordinate system. The remaining aies, translation 
and roiation of z, are the non-compliant a*es. During execution of the move, the 
non-compliant aies will be position serraed using a trajectory computed from the 
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move statement, while the compliant anes are force servoed using the. force 
( torque) statements.^ ^ s \ m ^ Ai fractional farces are negligible, the program can 
be executed without significant forces between peg and hole, 

A simple observation will assist in formulating a method for synthesizing 
such programs The peg-in-ho!e his two degrees of freedom, which we may 
choose to be translation along and rotation about the z-axis, The non^ompliant 
axes are also ^-translation and z-rotation* precisely the same as the degrees of 
freedom.^ This important property bads to a simple method for synthesizing 
force control programs — we simply write a move statement specifying the goal 
position of the end-effector with a force (torque) statement for each a*l5 
orthogonal to the degrees of freedom. The control strategy synthesis- method 
developed in succeeding chapters is analogous to the method of this example, but 
is appropriate for a very general class of task configurations. This generality is 
obtained by viewing a task configuration in terms of the resulting constraints on 
mcifmrL of the manipulator end-effectof- 

The main goal of this report is to formulate in precise terms a general 
method of control strategy synthesis The logical structure of the report is 
indicated in figure 12. In order to develop the method in a well-defined manner, 
we will deal with abstract models of the task configuration, the manipulator, and 
the goal trajectory- These models are the components of the ideal domain. The 
models and the mechanics of their interaction are well-defined in the ideal 



1. For the present it k necessary to appeal partly to intuition for the meaning 
of this program. 

2. The choice of degrees-of-frccdorrt is not [he only one possible. For example, 
we might also have chosen I he difference between i-translation and z-rotation, 
and the sum of z-translation and i-rotation. In any case, the plane spanned by 
the degrecs-of- freedom is the same as that spanned by the non-compliant a^e-s. 
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domain, so the synthesis method niay he defined and evaluated in- precise terms, 
In the LrfeaL domain, the manipulator is represented by the ideal effector, an 
object with no physical dimensions, with attributed of pOiition and Force Only. 
The task configuration is represented by equal inns relating the components of 
ideal effector force flnd velocity, These equa lions are referred to as the natural 
Constraints - A control strategy for the ideal effector is represented in the same 
way T as linear equal ions on effector force and velocity, called the artificial 
constraints . The anal trajectory gives the desired ideal effector position as a 
function of time, which must be consistent with the natural constraints. In the 
ideal domain the control strategy synthesis problem is to find artificial constraints 
which will reproduce the desired goal trajectory given the natural constraints. 

Thc synthesis of real-world control strategies consists of three steps. First* 
the task is modeled as a set of natural constraints in the ideal domain. Second, 
the synthesis method is applied in the ideal domain to obtain a set of artificial 
constraints. Finally, the artificial constraints are transformed into a 
corresponding real-world control strategy. The last Step would be accomplished 
by a low-level manipulator control system which enforces the artificial constraint 
equations on the manipulator end-effector. 

A model of the control system which was well-defined only when the ideal 
Surface coincides with the physical surface would be of little use. In actual 
practice* the natural constraints would be obtained from a geometric model of 
the task environment, the planning model, The ideal goal trajectory wiU 
therefore lie in the planning model surface, while the actual trajectory must lie in 
the real-world surface, Hence, the low-level control system is modeled as a 
projection of the ideal goal trajectory onto the real-world surface There are two 
appealing choices: project the trajectory along real-world surface normals or 
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along planning model surface normals. We will opt for the second alternative: 

The desired manipulator trajectory lying in the real- world 
surface is obtained by projection of the goal trajectory 
along planning model surface normals. 

There are many reasons for this choice. The rcahworld surface normals are 
unknown to the control system, while the planning model surface normals are. 
The use of planning model surface normals also simplifies planning/programming 
considerably. Given a particular goal trajectory and planning Surface, if we 
project the goat trajectory along planning surface normals, the position of the 
manipulator depends only on the displacement between the planning surface and 
the actual surface. However* if the projection is along real-world surface 
normals, the position of the manipulator depends On the orientation of the 
real-world surface as well. The difference is illustrated in figure 13, which 
depicts projection; from a planning model surface onto several actual surfaces 
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Q> planned positions 
• actual positions 



(b) 



Figure 1J. Position Projection Along Plan Normals and Real Normals, In (a) 
the planned position is projected onto real surfaces along the real surface 
normals, tn (b), the projection is along; planned surface normals. 
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using both methods. 



Furthermore, if the projection is along planning normals, an implementation 
which projects velocities rattier than position* will wort fine, hut if the Control 
system projects velocities along real-world normals then the position of the 
manipulator at any time will depend or the entire trajectory history. This 
situation is illustrated in figure 1.4, comparing the goal trajectory with the 
trajectories obtained by projecting velocities along planning normals and along 
real normals. An error of this sort might go unnoticed in many cases,, but some 
tasks are especially susceptible to error of this kind. For instance, if the 
manipulator were scribing a circle on a surface, slight Irregularities in the surface 
would prevent the end points of the manipulator trajectory from meeting. 
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Figure 1.4. Velocity Projection Along Plan Normals and Real Normals, The 
goal trajectory specifies motion from left to right along the planning surface (a). 
The trajectory velocity is projected onto real surface (b) using planning surface 
normals, and onto real surface (c) using real surface normals. The tick marks 
correspond to the effector position at successive intervals of time. 
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To summarize, the task configuration and gonl trajectory art transformed 
into a «t of natural constraints in the ideal domain. From the natural 
constraints is obtained a set of artificial constraints for the idea] domain, The 
artificial constraints are applied to the manipulator end*effector by a low-level 
manipulator control system. The resulting manipulator trajectory is judged 
according to how well it satisfies the projection criterion. The problem of 
obtaining the artificial constraints from the natural constraints and goal 
trajectory is the subject of chapter two. The transformations between the real 
world and the ideal domain are developed in chapter three. Chapter four consists 
of the concluding discussion and suggestions for further work. 

1.5 Relationship tq Previous Work 

This report is directly related to two different areas of manipulation 
research; manipulator force control, and automatic assembly planning- This 
section will briefly highlight previous work in these fields, and their relation to 
the work in this report. 

The earliest computer-controlled manipulator is described in [ErnstbLJ. 
Although Ernst's system had force sensors mounted on the hand, they were not 
used to servo effector force* but to delect contact during a motion. 

[Inoue?L] demonstrated a system which used force control to turn a crank 
and insert a peg in a hole. For each desired aris of compliance, the user selects a 
manipulator joint — a free joint — to be force-servoed- Inoue T s force control 
implementation was essentially open-loop; the actuators for the free joints exerted 
a constant torque for the duration of the movement. 
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(Paul72] implemented compliant motion using the free-joint method, Paul's 
system was also open-loop, but with, compensation for forces due to link 

accelerations. Free joint selection was automated; the user specified the direction 
and magnitude of the force to be applied in cartesian space. 

[Stlver73] implemented a closed-loop free-Joint system using a force-sensing 
wrist <[Minsky72j). A precision assembly task performed using this system is 
described in [[nOue74]. Free- joint selection was the responsibility of the user, frut 
the manipulator joints were permanently aligned with cartesian aseSt making, the 
choice simple. 

[Nevins74a] provides a good general overview of force control. Two 
methods, the generalized spring and generalized damper are of particular interest, 
as they readily provide formal models of force control and provide an interesting 
contrast with the force control models of this report. The generalized spring 
method has been realized mechanically [Nevins77] and the generalized damper's 
implementation in software, is considered in detail in [Whitney76J. 

|Pau|76] describes a cloosed-loop method of force control, and [Shimano77] 
describe} an implementation of a variation of this method The control strategies) 

supported by these systems are very similar to the strategies we will discuss, 

T«sk level planning has been investigated at Stanford [Finkel74, Taylor? 6), 
at Edinburgh [Ambler? 5], at MIT [Lozano76j, and at IBM fLieberman75|. These 
systems take task specifications expressed as operations on physical objects, and 
attempt to derive an appropriate manipulator program written using control 
system primitives. The last stage of this transformation is to derive the control 
program from manipulator motion specifications, i.e. control strategy synthesis, 
[Loeano76J and [Taylor7b] discuss this problem in detail. 
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2. Control Strategy Synthesis in the Ideal Domain 

2.1 Manipulator and Task Models 

The ideal domain is a mode] of the real world for which control strategy 
synthesis is particularly simple. In the ideal domain, the "manipulator 41 is the 
ideal effector, dir-inwl ro ha™ yurihmts of position and force only. The ideal 
effector's force and position are each represented as sis dimensional vector* over 
th* reals, The si* dimensions correspond to translation and rotation around the 
s-axis, y-aiis, and E-axis, 

The task configuration is represented by the subset of F 6 consisting of the 
possible jxjsitions of the ideal effector, called the jdeaj surface , The ideal surface 
must be connected, and must have a unique tangent space at each point. 1 The 
dimension of the ideal surface may vary from to 6. The tangent space is a 
vector flat (a vector subspace which has been displaced from the origin) witb the 
same dimension as ihe ideal surface A few examples of ideal surfaces will 
illustrate their proper! ies. An ideal surface of dimension is a point, 
corresponding ro the absence of any freedom of motion An idea] surface of 
dimension 6 contains all of F* near the effector position, representing complete 
freedom of motion, Figures 2.1 and 12 show ideal surfaces for a peg in a hole 
and for a crank, The six axes of fl 6 are the three translation components P K , P 
P^ and the three rotation components 0,, $ r and 9 Z . The ideal surface* in 
figures 2.1 and 2-2 may be decomposed into spaces embedded in fA Otherwise 
displaying these spaces graphically would be very difficult 



1. The spaces described sire open connected dlffercntiable sub-manifolds of R* 
but the properties we need will be assumed without reference to the 
mathematical theory of manifolds. 
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Figure 2.1, Tdeal Sufface at Center of Peg in Hole. The ideal surface is the 
plane equal to the cross-product of the two Jin.es depicted here. 



Since the ideal effector position lies in the ideal surface at all times, the 
ideal effector velocity will lie in the vector Gubspace parallel to the tangent sj>ace. 
This constraint can be expressed as a set of linear equations Ofi the Telocity 
coordinates. Similarly, if tangential forces are neglected* then effector force is 
restricted to be orthogonal to the tangent space, a constraint expressed as linear 
equations on. ideal effector force coordinates. Figure 2.3 depicts the tangent 
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Figure 2 2. Ideal Surface for Crank. The ideal surface h the cross-product of 

the spiral on the left with the point on the right. 



space (dashed line) and the parallel velocity space (solid line) for a frank. These 
linear equations in idea! effecior Telocity and force are the natura l constraints . 

The goa| trajector y in the ideal domain is the desired ideal effector position 
as a function of time, which must lie in the ideal surface. Finally, control 
strategies in the ideal domain, the artificial constraints, are expressed in the same 
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Figure 2.3. Tangent smd Velocity Spaces for Crank Surface. The tangent space 
is the cross-product of the dashed line on ihe left with the point on the right. 
The velocity space is the cross-product of the solid line with the point. 



form as the natural constraints: equations in components of effector force and 
velocity. The control strategy synthesis problem is to find artificial constraints 
which will produce the given goal trajectory for a given surface. This report 
develops a method for synthesizing the artificial constraints for a very broad 
range of surfaces, but we begin by considering very simple surfaces. The more 
general result is obtained by relaxing some of the restrictions on the surfaces, 

22 Zero-Energy Surfaces 

Consider again the ideal surface for a point at the center of a peg in a 
hole* with the hole fined in space (figure 2-1), The peg is able to translate along 
the z*axis and rotate about the z*axis h hut cannot translate along or rotate about 
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the other axes. Similarly, force along and torque about the x-a*is are zero (if the 
coefficients of friction are zero), while forces and torques for- the other ascs are 
unconstrained. So the natural Constraints for this task configuration are 

y y = . Wy = 

f z - r = 

ill 

where v^ ¥y represent component* of ideal effector velocity; V]f w y components 
of angular velocity; f f a component of effector force, and t z a component of 
effector torque, 

These equations are homogeneous linear equations in the component* of 
force and velocity, with the force equations orthogonal to the velocity equations. 
Formally, we define a itro-energy surface to be an ideal Surface giving a 
consistent set of homogeneous linear equations in the components of effector 
velocity, and an orthogonal set of homogeneous linear equations of effector fofce. 
These are called zero-energy surfaces since it is impossible fof the effector to 
e«ert a force in the same direction that it is moving. 

Zero^nergy surfaces correspond intuitively to real-world tasks comprised of 

stiff, immobile solids with negligible coefficients of friction. The definition also 
excludes any asymmetry of the constraint* with respect to direction. That ts ± if 
motion is impossible in one direction, it must be impossible in the opposite 
direct ion. A simple exampte of a physical configuration violating this restriction 
is a peg resting against the bottom of a hole, illustrated in figure 2 4 In this 
ease, translation along the positive z-axis is possible, but not along the negative 
z-axis. In fact, this configuration cannot be modeled directly as an ideal surface, 
since there b no unique tangent space. The transformation necessary to model 
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Figure 2.4. Peg at Bottom of Hole The ideal effectors A and B art rigidly 
attached to O 



this situation is developed in section 2.5. 

The effector velocity acid effector force are represented as vectors in a 

sijf-dimensional vector space over the reals {* denotes the transpose of t)i 

y = (v s V y Vj. w, y ^) T 

' - <f* fy ^z % T y T / 

If the constraints on r and f are represented in matrix notation, then for the peg 
in hole example of figure 2.1, wt have 



At = 

where A an<l R are given by 



(21a) 
(21b) 
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1 Q0000\ 

010000 

OOOOOO 

10 
0000 I of 
\o 00000/ 



B = 



/oooooo 1 
/ oooooo 

00 J 000 

oooooo 

oooooo 

I 00000 1 / 



Equations of the form of 2.1a and 2.1b restrict the effector force and velocity to 
lie in vector subsparas, denoted S f add S f respectively. For a aero-energy 
surface, R y cousins of all vectors which are orthogonal to every rector in S ft and 
vice versa. In other words S T and S f are orthogonal complements. 

For the configuration of figure 2.1, S T is the v « z plane, while $ { is spanned by 
the f^ T%t f y and r y ajtes. These two spaces are indeed orthogonal 
complements. 

The artificial constraints have the same form as the natural constraints, 
except thai the equal ions need not be homogeneous. There are two Criteria to 
del ermine whether the artificial constraints will produce the desired goal 
trajectory: 

The combined (artificial +■ natural) force constraints must 

be consistent, 

The combined vebcity constraints must be non-singular 

with the goal trajectory as the unique solution- 
There are many possible sets of artificial constraints which satisfy these 
conditions. Wc wilt focus on just those which are orthogonal to the natarai 
constraints. Just as the natural velocity constraints ctiuld be represented » a 
wctor subspace S fl the artificial velocity constraints may be represented as a 
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vector flat ((S ¥ )V) which is the result of displacing the subspact ($ w y- from 
the origin by 1 t, t e S y Now t an elementary result of linear algebra is that any 
velocity vector is uniquely represented as the Sum of a vector in S r and a vector 
in (S ? )l that is* B & is the dinxt sum of S T and fJS v )k The component of 
velocity along (S^)^ is determined! by the task geometry to be 0. The 
component along 5 T is- equal to the goal trajectory velocity, but by construction* 
it is also the displacement ? associated with the artificial constraint velocity flat 
((S^V). Hence the artificial velocity constraints art completely determined by 
the natural Constraint J and the goal trajettary- 

The situation is not as clear for the force constraints. The effector force is 
uniquely represented as the sum of a vector in Sj afid a vector in. (Sf) 1 . Again, 
the force component along (Sj) 1 is determined by the. task geometry to be 0* but 
the component along Sf is determined by neither the natural constraints nor the 
goal trajectory The magnitudes of the forces normal to the surfaces of this 
simple mode! are irrelevant to the satisfaction of the goal trajectory, so any 
values will do. 1 We may choose the artificial force constraints to be an 
orthogonal vector flat ((S f )-L,f) with f £ S fl but f is not completely determined- 
Arty particular value of f will work for a aro-energy surface. 



1. Since this is clearly not true in the real world, some explanation may be 
helpful. The zeroenergy domain abstracts away some properties of manipulators 
such as actuator torque liffliis, and properties of task configurations such as limits 
on how much force can be applied without upsetting the UsJ? t so that force 
magnitudes become unimportant. Upsetting the task configuration is a problem 
which will be addressed in later sections of this chapter, but considerations which 
depend tin the particular manipulator are better left out of the ideal domain, and 
will not be considered until the "Cut chapter, 
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So the artificial constraints- determine the component of velocity along S t 
and the component of force along Sj. For the configuration of figure 2.1, these 
considerations lead us to the artificial constraints 



f- = 



x 



fy - Ty = 

where k 1? k^ d *J*nd on ike goal lra|ectory p and may vary with time. In this 

particular case, force values of aero were used.* 

2.3 Non-J fornogeiieous Surfaces 

The definition of zero-energy surface constraints allows an asymmetry 
between the artificial and natural constraints — the artificial constraints are not 
required to be homogeneous There is no reason not to allow similar generality 
in the natural velocity constraints. Jrt fact, such a generalization will extend the 
scope of our analysis considerably. A non-homogeneous surface is defined to be a 
surface giving a set of natural constraints which may be non-homogeneous. Tht 
non-homogeneous surfaces include the lero-energy surfaces, 

Recall that for zero-energy surfaces the natural constraints may be 
represented by the vector subspaces S„ and S f containing the possible effector 
velocities and forces respectively. For rton homogeneous surfaces the same role is 



1. The magnitudes might ajso be left indeterminate in the artificial force 

constraints, to be resolved when the artificial constraints are transformed into a 
reahworld -control strategy, Such a technique might be useful in a planning 
system or in manipulator-independent programming. The planning system might 
specify only those aspects of the effector's behavior which axe relevant to the 
task, and allow other aspects to be resolved later with reference to the particular 



manipulator. 
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played by the veeior flats (S T ,vg) and (S^g) with tq e S^^ Tq £ SfK As with 
zero ^energy surfaces, S v and Sf are orthogonal complements. The artificial 
constraints are unchanged in form, and we will still choose the velocity 
Constraints to be the unique orthogonal set satisfying the goal trajectory . 
Likewise, the ariifictal farce constraints will be chosen to be orthogonal to the 
natural force constraints, with the force magnitudes still not determined uniquely 
by the goal trajectory. 

An example of the use of non-homogeneous natural velocity constraints is 
the problem of interaction between a manipulator and a moving belt on an 
assembly line. For instance, if the manipulator were to insert a peg in a moving 
hole (see figure 2,5) then the natural constraints would be 
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x 



'belt 
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w y 
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where the belt is moving in the k direction with velocity v^^. The 

corresponding artificial constraints are 

f s =0 

V I = *1 

which are the same as the artificial constraints obtained for a stationary 
peg-in-hole in section 2.2. The motion along the s-aws is taken care of by the 
force constraint along the *-am. This constraint forces the peg to follow the 
hole whether stationary or moving. 
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Figure 2.5. Compliance with Moving Beit. 



The symmetry between natural and artificial constraints is complete for 
non-homogeneous surfaces, and there is nothing put viewpoint to distinguish 
between a n arm control system and a task geometry. This unification allows an 
immediate extension to tasks involving multiple effector*. 

2.4 Multiple Effectors 



There is more than one way to develop controls for multiple effectors. The 
first method we will present is based on a genenliEation of the notion of 
orthogonal complement, and resembles previous use of force control for 
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coordinated use of multiple manipulators ([Nakano74)i [Ishida77]). A set of 

vector subspaces of R 6 are orthogonaf-compfementsry if their direct sum is Fr and 
if they are mutually orthogonal. Several manipulators may be coordinated by 
choosing (he artificial constraint sets so thati taken with the natural constraint 

set, they form an orthogonal-complementary set. 

Consider the two-dimensional example illustrated in figure 2,6, In this 
example, two effectors, A and B, are rigidly attached to the beam, O. Viewing 
the task First from A*s viewpoint, if there art no natural velocity constraints on 
O, then the space spanned by the x, y, and ases is the subs.pa.ee of possible 
velocities* and the artificial constraints at effector A may be. three velocity 
constraints- Now if we view the configuration from effector B, the set of natural 
velocity constraints Corresponds to the original natural velocity constraints plus 
the artificial velocity constraints of effector A. So, from B T s viewpoint* the 
subspace of possible velocities is just the 0-vector, and the artificial constraints at 
B must be three force constraints. Clearly, the roles of A and B may be 
switched. It is also possible to use velocity Constraints at A along the j-am and 
at B along the other two axes, or any other suitable mixture. However* All of 
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Figure 2.6. Multiple Effector Task. 
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these possibilities product asymmetry in the behavior of the effectors. This is of 
no consequence in the ideal domain, but the effects are observable in the real 
world, where I he manipulators would react differently to unexpected disturbances. 

A more appealing approach exists which is symmetric with respect to the 
roles of the two effectors. Fjfst. we find the natural constraints. The rigid 
attachment between the object and the manipulator? A and B gives the 
following identities between velocities. 

v Ai - "O* 
v Bx = v Ox 

V A8 = v O& 
V B0 = V O0 

— JL 1 t = v Gy 

v By - v Av 

If we assume that the only forces acting on effector A or B are the result of 

contact with ( .J, then by balancing forces and moments we have 

f Ax + f Bx = f Oit 
f Ay + f By = fay 

So far we have nine equations, obtained strictly from consideration of the 
interconnections of the manipulators and the object. An additional three 
equations will result from the interaction of O with the task geometry. By 
leaving these external constraints unspecified, the results we obtain will be 
applicable independent of the external task configuration. Some manipulation of 
the nine internal natural Constraints gives- us: 



v A0- v B* = O {12b> 

^L,lM. VA$ =0 {lie) 



and 



*Ai " v 0k 
V A0 = V O0 

Va„ + V 



(2Ja) 



A T . J v By = VQy (2.3c) 

f A , + %* " %x < 3 W > 

f Ay + f By = f 0y < I3 *> 

2 f By' r f Aj ffA ^ fB#sfog ( 2JQ 

Equations 2.2 can be viewed as natural constraints on the velocity components of 
the effector pair, Equations 2.3 give us a transformation from velocity and force 
of the object to velocity and force of the effector pair. These can be used to 
transform external constraints on O to constraints on the manipulator pair. 
These transformed constraints, taken with the first three equations (equations 
2,2% can be treated like any other set of natural constraints. Note that the first 
three, though, arc independent of the esternai constraints on Q- They result 
strictly from the geometry linking the effectors together. Hence, we can 
determine three of the artificial constraints independent of the external 
constraints on O. They are 

<2-4a) 
(Ub) 

r , F A *-« &** 

Again, force values other than zero could be used, but zero gives an appealing 
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symtnetry. The remaining three artificial constraints depend on the external 
constraints on O t and arc determined using the transformations above. For 
example, suppose O is pinned at its center so that only rotations are possible. 
Specifically, the natural constraints on O are 

v O* =0 (2 5a) 

v Oy = ° <2.5b> 

f O0"° (2.5c) 

Applying ihc transformations (equations 2.3) we obtain natural constraints on A 
and B. 

v Ai ■ (2 6a) 

2 JLii + f Atf + rw = o (2i6c) 

The corresponding artificial constraints are 

f As = ° (2.7a) 

f Ay + f py ft 






(2.7c) 



where k is determined by the goal trajectory The final set of artificial 
constraints is the conjunction of equations 2.4 and 2.7. A little cleaning up 
yields: 
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(2.8b) 
(2«c) 

(18d) 

(2-8e) 



2^-l- V Al + fc <2Sf) 



v A0 +v B0 

These constraints prevent compression of torsion of the bar linking the two 
effectors, they prevent any component of force- ai the pin in the x-y plane, and 
provide for compliant rotation of the bar about the pin. 

This, demonstrates how to transform a set of task constraints and a linking 
geometry into constraints for multiple effectors. We obtain two sets of natural 

constraints, one set due to the geometry connecting the effectors, and one set 
transformed from the external task constraints. The corresponding sets of 
artificial constraints play different roles in the resulting system. The artificial 
constraints obtained from the connect ing geometry are used to determine the 
"mode" of cooperation of the effectors. In the example, they provide for 
symrnetry H prohibiting any opposition between the manipulators- The artificial 
constraints obtained from (he external constraints are used to obtain the desired 
external function. 

2,5 Half-Surfaces 

A simple example of a task not directly modeled by an ideal surface was 
shown in figure. 2.4, In this example the peg is at the bottom of a hole, and may 

move upward along the z-asis, but not downward. This gives rise to constraints 
expressed not as equations but as inequalities: 
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There are two possible modes of motion possible in this case: withdraw the peg T 
or rotate the peg while maintaining com act with the bottom of the holt. The 
first mode corresponds to traversing the interface be J wet n two ideal surfaces of 
differing dimensions, A control sij;:h^ to accomplish such motions fill? into the 
class of guarded moves {section U), and is not treated in this report. It is the 
second mode which interests us. In order to apply the analysis of preceding 
sections, we use as a natural constraint 

v z = 

and as the corresponding artificial constraint 

In previous sections, the value of t was. irrelevant, but this is no longer so. In 
order to obtain a consistent .set of force constraints* * must be non-positive. In 
practice, a small negative value for <?, a small biai force, should be used to allow 
for error in the control system. 

The result is that ihe ambiguity introduced at a half-surface may be 
resolved by examining the goal trajectory. If the trajectory moves away from the 
half-surface, the motion must be initiated using a guarded move. If the 
trajectory lies along the half-surface, we can pretend it is a "full" surface, as long 
as we guarantee continued contact by using a bias force. 

For example, consider the task shown In figure 2.7, and suppose the goal 
trajectory specifies motion along the surface The natural constraints art 



-J7 



V* 



v 



e 




Figure 2.7. Two Dimensional Surface. 



f y = 
ftf-0 



and the artificial constraints wilt be 



(2.9a) 
<2.9b> 
<2.9c) 






(2.10a) 
(2.10b) 
(2.10c) 



where s is a small positive bias force and 1^, k2 are determined by the goal 
trajectory. This triclq of making assumptions to change- the natural constraints 
from inequalities into equations, and then using the effector program to guard the 
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assumptions, will also be used in the ne*t section to handle sliding Friction. 

2.6 Force Thresholds 

A half-surface gives rise to an ambiguity — we have the freedom to treat it 
as a surface or not, as we choose. Sliding friction produces a similar phenomenon 
by virtue of its threshold nature. A common model for sliding friction 
lSimunovic75J is given by 



i - ■b]^ if N > o 



f = f, v 

|f|| 5 [q otherwise 

where f t is the force Component along the surface tangent, ¥ is the velocity 

vector, and f is The force threshold, fy is sometimes the product of the normal 
force and the coefficient of friction. 

This type of constraint can be treated in a fashion similar to that used for 
half surfaces. In this case, the choice of model depends on whether or not 
motion relative to the surface is specified by the goal trajectory, and the 
assumptions can be guarded by choosing either a rton-iero velocity or a forte 
with magnitude less than f fr In contrast to the situation with halfsurfaces, both 
modes are readily described by ideal surfaces. Returning to the example of figure 
2.7, suppose the coefficient of friction of the surface is ^ Then the new natural 
constraints are 

v i = alia) 

v 

f y = * f * F*[ (2.iib) 

f tf"° (2,11c) 

if Vy is non-zero, or 
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(2. 12a) 
(2.12b) 
(2.12c) 



if v y = 0. If the goal irajectory specifics motion upward along the surface, then 
the artificial constraints will be pceci&eLy the same as in the section 2.5, equations 
2 10- On the other hand* if the goal trajectory specifies a velocity of zero along 

the y-axis, then the artificial constraints will be 



f y = 



(Llla) 
(Lift) 
(213c) 



where t is a bias force chosen as in section 2.6- As for a half-surface, the 
ambiguity tun be resolved to satisfy the fcoal trajectory. The alternatives for the 

example are represented in table form below. 



Motion 
Desired 



Natural 
Constraints 



Artificial 
Constraints 




The use of force threshold constraints ma) 1 also rje a convenient way to prevent 
excessive forces which might upset the task configuration. 
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2.7 Tangential Forces 

The friction example of the previous section exhibited components of force 
along the surface (anient. Masses and springs also give rise to force* along 
surface tangents The resulting natural constraints can he extremely complicated. 
Fortunately, some surfaces have the useful property that the normal forces are 
unconstrained, and in particular do not depend on the tangential forces. If this is 
the case the artificial constraints may be selected as before with assurance of 
consistency with the natural constraints, and the complicated nature of the 
tangential natural constraints may be ignored. 

Suppose that we arc given a set of natural velocity constraints, and suppose 
that the artificial velocity constraints are chosen Hi be perpendicular to the 
natural velocity constraints, and the artificial force constraints are parallel to the 
natural velocity constrains. Clearly the combined velocity constraint* are 
nfwvsingular. Likewise, if normal forces are not naturally constrained the 
combined force constraints will be consistent and independent. 

For example* consider the task shown in figure 2.8. In this example, a 
two-dimensional bead is constrained to move along a wire. The natural 
constraints are 

v y -0 
v fl =0 

f * " m dT K 

where m is the bead's mass, a constant. This example satisfies the crucial 
assumption — there is no constraint on forces along the y-axjs or 0-aiis, 
Accordingly, the artificial constraints of the form 
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Figure 2.9. Bead on Wire. 



(where, as usual, k may be a function of time) are non-singular. 

In general* determining the natural constraints may not be possible. 
However, the upshot of this, section is lhat the natural force constraint* need not 
be determined, as long as we may assume that there is no natural constraint on 
the normal force. The artificial constraints may be chosen solely on the basis of 
the natural velocity constraints. The details of the relation between forces and 
the position trajectory along, the surface tangent will not come up until we get to 
implementation of real-world control strategies (section 12\ 

The critical assumption of unconstrained normal force is valid for a broad 
range of task configurations. An example violating this assumption is the sliding 
friction example of the previous section, where normal force f, was constrained 
by the equation 
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Ail other interesting example which violates the assumption is a spinning top, 
which transforms a force along one axis into u velocity along an orthogonal ajtis. 
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3, Transformations 

3,1 From Real- World Tasks to Natural Constraints 

Many aspects of the transformation from real-wOrld tasks to natural 
constraints were suggested in the preview chapter. In particular* natural 
constraints for surfaces, friction, in asses* and springs were developed. Rather 
than belabor these aspects of task configuration, we will proceed to consider 
objects with positive physical dimensions {section 3.1.1) and time-varying 
constraints (section 5,1.2). 

3.1.1 Dealing with Objects of Positive Extent 

The methods of the previous chapter require that the task be represented as 
const rain is on the velocity of the ideal effector, which has no physical 
dimensions, The real world is composed of Objects for which the physical 
constraints are distributed in space. Before applying the idea! effector methods, 
it will be necessary to collect these constraints at a single point. 

The approach described here follows a common approach to the analysis 

and synthesis, of mechanical linkages [Hartenburgo4]. Let us assume we have the 
task represented as a set of rigid bodies, links, which are connected to one 
another by one of the fower pairs, eshibited in fi&ure 3.1. The contacting 
surfaces of the two links of a pair are called the elements of the pair. A pair 
imposes a constraint on the relative velocity between the elements of the pair. Id 
fact, the relative velocity is cons trained to lie in a vector subspace. For example, 
the screw pair gives the following Constraints: 



Reuofute 



u 




Cylindrical 





Prismatic 




Fi?ur« 3,1. Lower Pairs. 
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v x = v y = **x ■ *y 



L 

2 w ™z 



v, ■ ^=-w, ■ 



where Tpj,^ - (ir x v v z ^ u w z ) T is the relative velocity of the pair (the 

difference- between the velocities of the pair elements}., and L is the Jead of the 

scre-u't the advance per revolution. 



The natural constraints in the ideal domain for a task consisting of links 
connected by pairs may be determined by propagating velocity constraints to a 
common |ioint at the effector. The propagation of constraints is handled by two 
operations; translation along links, and passing through pairs. For translation of 
velocity constraints along links, let us assume that A and B are two points rigidly 
attached to a link- [f S^ and Sp are the velocity subspaces for points A and B 
respectively, ihen Sg is the image of S^ under the linear transformation T- 

Sjj = T(Sy^) 

where T is represented in matrii form by 



T = 



I 



' 



i 



'h\ 



Rj 
■R z . 
R y -R, 



where R = (R x R y R z ) is a 3-vector from point A to point B. 

Passing constraints through a pair is slightly more difficult If the velocity 

constraints for one element of a pair are known, and if the relative velocity 
constraints for ihe pair are known, we can determine the resulting velocity 
constraints for the second element of the pair. If the relative velocity constraint 
subspacc is 5p* and the velocity constraint space of element A is S At we have 



and the resulting constraint on Tg is 

where Sp © S A consists of all vectors which may be expressed as the sum of a 
vector from Sp and a vector from S* . 

Using these operations the velocity constraints may be transformed to a 
common point. If two different constraint sets are obtained at a single point, the 

corresponding velocity subspace is obtained by intersecting the two original 
subspaces. Accordingly, the method proposed is to trace every chain of links and 
pairs from "ground " (presumably the workbench) to the effector. The 
intersection of the resulting subspaces gives the appropriate velocity constraint for 
the effector. As an example* consider the task configuration of figure 3.2. The 
constraint at A allows translalion along the s-aiis and rotation about the *-axis, 
while the constraint at B allows translation along the ranis and rotation about 
the z-asis. We wish to find Lhe velocity constraints on point P. tf O is assumed 
motionless, then we have at A- 

v Ay =0 
W A* = 

and at B: 
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Figure 3.2. Eiampk of Velocity Constraint Determination 



^=0 

Letting R A and Rg be the Sectors from A to F and from B to P r 

R A = <2 Cos(0), 2 sinfa), 0) T 
R B = (eos(#), sin(*) P 0) T 

the appropriate linear transformations T A and Tg are 
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T A = 



T B = 



/ I -l nam 

I 1 2cos(0) 

2 sin(^) -2 cos(£) 

' I 

10 o 

1 sin(#) -cos(*) 

7 , r 



. 



-sin(*) | 
CO$|>) 





Now S A is spanned by the vectors 1, = (1 0) T and L$ = (0 1) T 
ajid S B is spanned by L 2 = (0 1 0) r and 1 6 . 3o S p is obtained by 
intersection of the space spanned by T^ij) and T A (1 6 ) with the spa« spanned 
ty T B^2) an(J T fl( l 6J' Restated as vector equations we hart 

*P ' *! T AW + *2 T A (i6> 
T P = k 3 T B^ + k 4 W 

Expanding these into scalar equations and eliminating the unwanted variables, we 
finally obtain 

vp^ + «nf>) up^ = 
vp„ - 2 CO&C0) djp r = 
v Pl =0 

*Px = 

which are the natural velocity constraints for the point P. 

Unfortunately, not all task configurations are as easily modeled m this one. 
The problem is that the relative velocity constraints introduced at a pair depend 
on the oriental ion of the pair. This in turn may depend on the relative positions 
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of any number of pairs in the mechanism. Hence application of this method 
must in general be preceded by a positional analysis of the task. There is no 
general algebraic method of kinematic analysis, available, although methods eaist 
for various special classes of mechanisms (for example see [Duffy74]). If 
numerical methods are considered, the situation is somewhat improved [Llicker64]. 

3.L2 Time-Varying Constraints 

In order for a control strategy to be useful, its built-in assumptions of state 
should hold for some reasonable amount of time. For some tasks, the natural 
constraints are constant; for others they vary with time, either because the task 
surface is in motion, or because the manipulator is moving on the surface. Since 
the artificial constraints are orthogonal to the natural constraints, the artificial 
constraints will ateo be functions of manipulator position and time. 

As an example, consider the dcor-closing problem in two dimensions. 
Figure 3.3 illustrates the problem. The effector is rigidly attached to the 
doorknob- Tf we assume any friction is negligible,, the natural constraints at the 
instant shown are 

v x = 

v y -R*f 

Unfortunately, the instant the door moves, the natural constraints will change. 
In this case, the natural constraints are easily expressed as a function of flj-j, the 
angle the door makes with the horizontal. Si#cificaily, 
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Figure 3J. Door Closing Problem. 



cos(%>) v K + ftn(^,} v y = <3.La) 

-*in(l^,) v^ + cos<^) v y -^^0 <31b) 

*in(%) f, + cos(^) f y + i- fy = {3,1c) 

The artificial constraints may also be expressed in terms of ^, obtaining a single 
set of arti fkial constraints which is appropriate for any state of the door. 

A simple method for specifying a similar control strategy is obtained by 
observing th«t the natural constraints as measured in the coordinate frame of the 
effector are constant, So the artificial constraints wjj[ also be constant in the 
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effector frame [Paul7&]. If the effector frame is initially aligned with the 

external coordinate frame then the artificial constraints are 

f y -Rf0 = O (Ub) 

where the velocities and forces are measured in the effector frame. If the 
artificial constraints are expressed in terms of &^y, a method for determining Bq 

h needed. There are three reasonable alternatives; 

Use the planned value for 0r> computed from the goal 
trajectory- 
Compute ft\ from the actual manipulator's z-rotation in 
real time- 
Compute ^j from the manipulator's position in the i-y 
ne in real time. 



Sinee the manipulator will undoubtedly stray slightly from the planned trajectory, 
these three methods will gh'C different results. Usually the first met hod i% beat, 
because it leads naturally to trajectories satisfying the goal as formulated in 
section L4- However, Ef the information On the door it inewnplete, and large 
trajectory errors are possible,, one of the latter two methods would be preferable. 



1. To be precise, the velocities are measured in an external frame and 
transformed to the effector frame. If they were measured directly in the effector 
frame, the effector velocities would always be aero. 



3.2 From Artificial Constraints into Control Strategies 

The last step in the synthesis of control strategies is the transformation 
from .-LHiEiml co!i-.l-; ; iri:s :o real-vorld corned strategies. Sinue the ideal effector 
corresponds to the end-effector in the real world, the artificial constraints are 
interpreted as equations to be satisfied by the end-effector. The role of 
"equation enforcer" can be performed by a system which resembles control 
systems already in use [PauI76, Shimano77} This section is primarily concerned 
with the design of such control systems, which leads into a discussion of error in 
tlie tlmI world. 

The problems of low-level control of manipulators are very complex. A 
detailed description of a low-level control system capable of enforcing artificial 
constraints is beyond the scope of thes report. Nonetheless, success of the 
methodology developed in the preceding sections depends on the prospects of such 
a control system. While it is clear that the artificial constraints will produce the 
goal trajectory in the ideal domain, it is critical that they work in the real world. 
The nature of an implementation must be considered to properly assess this 
question. 

There are three fundamental problems of classical mechanics which have 
been solved for many research laboratory manipulators. They are: 

Kinematics. Given the position of the end effector in 
cartesian coordinates, determine the corresponding 

manipulator joint positions. 

Swits. Given the force exerted by the effector of the 
manipulator, determine the corresponding forces developed 
at the manipulator joint actuators. 
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Dynamks. Given the position,, velocity, and acceleration of 
each manipulator link., determine the corresponding forces 
developed at the manipulator joint actuators. 

A solution to the first problem enables a system to transform a goal trajectory 
defined in cartesian space to a trajectory in joint space. Analytic solutions for 
this problem are known for most research arms [PieperniL, Paul72, Hom74J. The 
solution to the second problem is the simplest, because the transformation from 
forces in cariesian space to forces in joint space is linear. If f c is a vector of 
farces in cartesian space, and T. is a vector of forces in joint space, then we have 

' j = F h 

where F is the force resolution matrix. It so happens thai the force resolution 
matrix bears a simple relation to the solution to the kinematic problem The 
Jacofoian is a matrix whose i-jth entry is the partial derivative of the ith cartesian 
position coordinate with respect to the jth Joint position variable. 

where di is the differential cartesian position vector^ dl? is the differential joint 
position vector, and J is the Jacobian. The force resolution matrix is just the 
transpose of the Jacobian matrix [GroomeT2]. 

F = J T 

The solution to the dynamic problem is more complicated [Kahn69 f PauH^ 
Bejczy74f Horn75). Although sophisticated dynamic models are available, most 
control systems- are based on simplified models of the dynamics. 
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Given solutions to the three problems outlined above, an open-loop control 
system could be constructed as in figure 3.4. The control system translates the 
goal trajectory from Cartesian coordinates to joint coordinates by inverting the 
kinematic equations. The static equations are used to derive actuator torques 
from the effector forces. To these are added the actuator torques obtained from 
the joint motions using the dynamic equations. The resulting torques would be 
applied at the appropriate actuators. This system works precisely the same 
whether force control or position Control is desired. The two different Control 
modes are only distinguished in the manner in which feedback is used. 

The open-loop method is not generally used due to the presence: of error. 

The planning model cannot represent the real task with complete accuracy. The 
static and dynamic equations are also inaccurate.' The use of sensory feedback 
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Figure 34, Open Loop Manipulator Control System. 



1, Most control Systems use very simple dynamic models. [Raibert77} and 
[Horn77b] describe a control method using a better dynamic model, but in any 
case error will still be a factor. 



55 



compensates for the insecurities of the task and manipulator models. However, 
when the loop is closed the force and position control systems are no longer 
identical. For one thing, a closed loop force control system would naturally 
require force sensors, while a position control system would require position 
sensors. For a hybrid system, combining f"*ce control of some axes with position 
control of other a*es t both position and force error must be determined. 
However, the position errof is reckoned only along the position antes, and the 
force error only along the force axes. In the language of the ideal domain, the 
force error is projected onto the planned surface normal space* and the position 
error is projected onto the planned surface tangent space. The resulting, 
calculated error is the distance from the artificial constraint spaces, as it should 
be. Note that the planned surface is used for the error projections + consistent 
with the definition of the goal trajectory (section 1.4). 

The calculations required for the implementation described above are very 
time-consuming. Some of these calculations may be avoided using the fr& joint 
method [Pauft^ FaulTu, and Shimano77j, This approach is easily grasped by 
considering a task with the property thai each force or velocity constraint 
happens to be aligned with a manipulator joint. In that case, the force axes can 
be servoed on force and the position axes on position in an independent fashion* 
which is precisely the method used in [Inoue7l] and [Silver? 3]. Even if the joints 
are only approximately aligned with the desired constraints, good results may still 
be obtained. Based on this observation, the control system in [Paul? 2] accepts 
arbitrarily oriented force constraints and approximates, them by constraints 



1. The alignment of manipulator joints Kith natural constraints might occur 
surprisingly often 1 since most assemblies require compliant motions along one of 
only a few possible lines of approach [Nevins77]. Hence a manipulator might be 
used with its joints aligned with these lines of approach. 
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aligned with manipulator joints. The constraints and joints are matched by using 
the force resolution matrix to find the joint most sensitive in the direction of the 
constraint. The corresponding actuator torque it held constant without regard 
for any normal forces, contributed by the other manipulator joints Similarly, the 
position axes are servoed without regard for tangential motions contributed by 
free joints. The resulting errors limit the usefulness of the system. 

These problems were remedied in [Paul7o], Forces due to posit ion servoed 
joints are automatically accounted for by usiri£ force sensors to read the actuaJ 
forces at the effector. Tangential motions due to free joints are calculated and 
used in the position servos [Shirnano77j ckj-crihei an implementation of a similar 
system Neither of these schemes will accept a force constraint which includes 
components of torque and force, such as the constraint 

f y - R f * = 

obtained in section 1 U for the downing trample. Ako, neither system 
projects the goal trajectory using planning surface normals in alt circumstances, 
although these differences could probably be eliminated without too much 
difficulty. 
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4. Conclusions 

4.1 Discussion 

The primary goal of this work was to develop a method for synthesizing 
control strategies for compliant motion, using a precise language to describe force 
control. To that end, the formal models for surface, manipulator, and control 
strategy were defined, and a precise formulation of goal trajectory obtained. The 
synthesis problem is considerably simpler for these abstract objects, and the 
control strategies obtained are appropriate for many compliant motion tasks in 
the real world. The most important aspects of this method are the 
representations of surface and manipulator The use of sub-manifolds of R to 
represent surfaces focuses directly on the most important characteristic of a 
compliant moiion task — the degrees of freedom of the manipulator The 
unified treatment of relational and transitional variables led to the synthesis of 
control strategies which couple rotation and translation of the manipulator 
effector, an aspect of compliance which was previously neglected. The precis* 
formulation of goal trajectory and the associated criteria for the manipulator 
trajectory (i.e. the projection of the goal trajectory along planning surface 
normals) has not been discussed in substance previously, although the desirability 
of some such projection properly is mentioned in an example in [Faul76]. 

The use of artificial constraints orthogonal to the natural constraints is an 
important aspect of the synthesis method , For velocity constraints, this is the 
only choice that will produce a trajectory satisfying the goal trajectory criterion 
(section 1.4). The value of orthogonal force constraints is illustrated in figure 
4.1. The planning model force constraint is represented by a solid line, the 
real-world force constraint by a dashed line, The orthogonal artificial constraint, 
pictured on the left, gives much better results than the artificial constraint 
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Figure 4.1. Comparison of Orthogonal and Von-Orthogonal Force Con&trairits 
The effect of an error in the planned natural force, constraints is compared for an 
orthogonal artificial constraint (left) and a non-orthogonal artificial constraint 
(right). 



pictured on the right. If bounds for tht normal force were determined in the 
planning stage, the non-orthogonal artificial force constraint might result in a 
force violating the bounds, thereby losing surface contact or upsetting the task. 
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An interesting question arises in connexion with the representation of ideal 
surfaces — given an arbitrary ideal surface, is there a corresponding task 
configuration realizable in the real world. The answer is yes, because: the 
transformation from artificial Constraints to real-world control strategies is a 
method for constructing a physical realization for an arbitrary ideal surface. In 
this sense 1 one can think of the manipulator as a programmable ideal surface. In 
the vicinity of itte effector position the planning surface and "manipulator 
surface" will have exactly one common point. The two surfaces are orthogonal 
at this point + and the position of this intersection (as a function of time) is the 
goal trajectory. The real trajectory will be the intersection of the real task 
surface with the manipulator surface The projection property is a simple 
consequence of the use of a manipulator surface which is orthogonal to the 
planning surface. In this view of compliant motion* force control is just a 
manipulator surface* and the control Strategy Synthesis method says simply to use 
a manipulator surface which is orthogonal-complementary to the planning surface. 

The ideal effector has potential applications in other areas- of manipulation. 
It is used implicitly in previous task planning systems (particularly (Udupa77J, 
[Lo2ano7Efl, and seems to be a good way to develop manipulator-independent 
programs. Much of the planning process can be decomposed into a st^i^e 
concerned primarily with task level planning in terms of the ideal effector* and a 
stage to interpret an ideal effector program using some particular real-world 
manipulator The ideal effector can also model objects in the environment other 
than the manipulator end-effector. In fact* in this report the ideal effector was 
often identified with some geometrical solid which was not a manipulator, This 
generality is important for planning purposes, for the desired compliant motion 
often does not involve the end effector directly* but rather an object grasped by 
the effector. 
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It must be Emphasized that there are- other type* of control strategies which 
might be used for compliant motion Two in particular are the generalized spring 
and the generalized damper methods. In the generalized spring method, the 
control strategy enforces the relation 

f = K <p - p ) 

where f is the effector force, p is the effector position, and jhq ig the nominal 
position, which is input supplied from the planning system or user program. K is 
the stiffness matrii, which relates forces observed at the effector to deviations 
from the nominal position. The stiffness cruris can be chosen to optimize 
performance of a particular task. This approach was pursued at the Draper Lab 
and culminated in a mechanical implementation capable of extremely fast peg 
insertions.. 

The generalized damper method is similar in form. The control strategy 
enforces the relation 

f = B {t ■ Vq) 

where f is the effector force, v is the effector veJocityp and ¥ fl is the nominal 
velocity, which is input from the planning system or user program, B is the 
damping matrix, in this case relating effector force to deviations from the 
nominal velocity. A generally useful choice for B is just the identity matrix 
times some negative damping coefficient. Other choices may exhibit interesting 
properties. For instance, it is possible to choose B so that the manipulator will 
climb over any obstacles it encounters. Many early force compliance schemes 
lGroome72, Silver73j are conveniently viewed as damping schemes. Both the 
generalized spring and damper methods are discussed in [Nevins74a] and the 
generalized damper is discussed further in [WhUney76]. We couW also define a 
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generalized inertia control strategy, which would be a convenient model for the 
free- joint method of force control. 

These control strategic (when a reasonable stiffness, or damping matrix is 
used) have the advantage of being consistent with almost any naturally occurring 
set of natural constraints. However, their effect is more difficult to model than 
the ideal surface strategics presented in this report, For this reason, they are not 
as convenient from the planning point of view. From the implementation point 
of view, though, these models are indispensable. For instance, an implementation 
of an ideal surface strategy might look like a generalized spring with the position 
axes very Miff and the force axes very loose, 

4.2 Suggestions For Further Work 

This report touches on many aspects of manipulation, so many of the ideas 
and problems have been only partially developed- The control strategies 
developed were not compared in any precise sense with other strategies for 
compliance* the generalised spring and damper methods in particular. Likewise 
the design choice restricting artificial constraints to be orthogonal to the natural 
cons-train ts was only addressed superficially in ihe jeport. This is particularly 
interesiing, since many of the published examples of compliance programs 
correspond to a set of non-orthogonal constraints-. 

Integrating the control strategy synthesis technique into a complete planning 
system is an interesling problem, A trajectory traversing several surface* might 
be decomposed into several segments, each lying in a single surface. The 
transition from one surface to another requires a guarded-move type of control 
strategy. The synthesis of guarded-move type strategies for the interface between 
two surfaces is an interesting problem in its own right. 
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The report emphasis the use of the ideal domain for synthesizing artificial 
constraints, but it was felt that the chapter on transformations between the ideal 
domain and the reai world was necessary for logical completeness The particular 
transformation methods described were meant to play the role of a constructive 
existence proof, A more serious effort on this problem would be justified. 
Velocity analysis of mechanisms has not been neglected in the kinematics 
literature (for example see [DenavitoSJh but the current work is focused an single 
degree of-frcedom closed kinematic chains, with limited applicability to 
manipulation tasks. 

The difficulty of implementing an active force control scheme should not 
be judged by the scant attention it receives in this report. There are important 
unresolved issues both in hardware and software design. Ultimately any 
compliant motion method will be Judged by the velocity achieved without 
exceeding a specified force error, which depends on the frequency characteristics 
of the force control loop. In [Nevins74bJ this argument is pureed to suggest the 
use of re^lii nd ant degrees of freedom to provide compliance. The remote^center 
compliance device [Nevin 5 77] uses passively compliant redundant degrees of 
freedom, A programmable active compliance is necessary to implement tbe 
compliant motion primitives developed in this report, but so far no active 
compliance using redundant degrees of freedom has been built. 



References 

tAint)lcr751 

Ambler, A. P., Barrow T EL G, t Brown, C. M., Burstall* R. M. ( and 
Pnpplestonc, R. J. t "A Versatile System for Compfiter-Coatroitad 
Assembly", Artificial Intelligence, vol. &, 1975. 

!Barbtr?i7G] 

Barbera, J. A., Albus, J. k, and Evans, J. M-, "Control Strategies for 
Industrial Robots Systems", Society of Manufacturing Engineers 
Technical Paper MR76-616, 1976. 

[Bejciy74] 

Bejczy, A. K.j Robot Arm Dynamics and Control Jet Propulsion 
Laboratory Technical Memo 33-669, February, 1974. 

[Bolle&73J 

Bolles, R. C, and Paul, R-, "The Use of Sensory Feedback in a. 
Programmable Assembly System", Stanford Artificial Intelligence 
Laboratory Memo AlM-220, October* 1973, 

(DarriiigcrJS) 

Darringer, J. A., and Blasgen, M. W. p "MAPLE: A High Level 
Language for Research in Mechanical Assembly", IBM Research 
Report RC-5606, September, 1975- 

IDenavit65) 

Denavit, J. T Hartenberg, R, $., Razi, R-> and Uicker, J. I, "Velocity, 
Acceleration, and Static-Force Analyses of Spatial Linkages", 
Journal of Applied Mechanics, December* 1%5- 



-64^ 

[Duffy74) 

Duffy, J., and Rooney J. p "Displacement Analysis of Spatial 
Six-Link, 5R-C Mechanisms 1 ', Journal of Applied Mechanics. 
September, J 974. 

[Dunne77] 

Dunne, M J. t "An Advanced Assembly Robot", Society of 

Manufacturing Engineers Technical Paper M577-755, 1977. 

[Ernsi61] 

Hi-t^t, H, A., MH-h A Computer-Operated Mechanical Hand. Sc. D. 
Thesis^ MIT, December, 1961. 

[Finkel74] 

Finkel, R, Taylor, R., Bolles, R, and Feldmari. J., "AL ( A 
Programming System for Automation", Stanford Artificial 
Intelligence Laboratory Memo Number AIM-243, November, 1974, 

[Finkel76J 

Finke], R., "Constructing and Debugging Manipulator Programs", 
Stanford Artificial Intelligence Laboratory Memo 284 + August, 
1976. 

EFieund76] 

Freumd, E., and Syrbe, M„ "Control of Industrial Robots- by Means 
of Microprocessor^ Collogues IR]^ Analra; de Systemes et ses 

Orientation^ NouveJIes. 1976. 



6 J 



[Goto74] 

Goto, T-, Inoyam^t Ti and Takeyasu, K. p "Precise Insert Operation 
by Tactile Controlled Robot", 2nd Conferen ce on Industrial Robot 
Technology. March. 1974- 

tGroom*72] 

Groom*, R. C. 5 Force Feedback Steering of a Tcleoperator Bvstfctn^ 
M. S. Thesis, MIT Department of Aeronautics and Astronautics, 
August 1 4, 1972. 

[Hartenbufg64] 

Harienburg, R. S. T and Denavit, J., Kinematic Synthesis of Linkages, 
McGraw-Hill, 1%4, 

[Hol1erbach77] 

Hotlerbach, J. M. t "The Minimum Energy Movement for a Spring 
Muscle Model", MIT Artificial Intelligence Laboratory Memo No. 
424, September, 1977. 

LHoni74] 

Horn, B- K. P. T and Inoue, H., "Kinematics of the 
M1T-AI-VTCARM Manipulator 1 ', MIT Artificial Intelligence 

Laboratory Working Paper b% May 1974, 

|Horn75] 

Horn, B. K. P., "Kinematics, Statics* and Dynamics of Two-D 
Manipulators", MIT Artificial Intelligence Laboratory Working 
Paper 99, June 1975, 



~b6- 

[Horn77a] 

Horn, B. K. P., Hirofcawa, K , and Vazirani, V. V,, "Dynamics of a 
Three Degree of Freedom Kinematic Chain", MIT Artificial 

Intelligence Laboratory Working Paper No. 155, October, 1977. 

lHcrn77b] 

Horn, fl. K. p., and Raiberr, M. H. p Configurat ion Space Control. 
MIT Artificial Intelligence Laboratory Memo 45$, December, 1977, 

[Incue71] 

Inoue, H r "Computer Controlled Bilateral Manipulator", Bulletin of 
the JgMB, vol, 14* no. 69, 197L 

Pnoue74J 

Inoue, H. T "Force Feedback in Precise Assembly Tasks,", MIT 

Artificial Intelligence Laboratory Memo no. 3£}S, August 1974. 

[Ishida77] 

Ishida, T* "Force Control in Coordination of Two Arms", 
Proceedings, Fifth International Conference on Artificial 
Intelligence, August, 1977, 

fKahn69] 

Kahn, M. Ei "The Near-Minimum-Time Control of Open-Loop 

Articulated Kinematic Chains", Stanford Artificial Intelligence 

Memo Number 106 h December, 1 969. 

[Lewj 5 74] 

Lewis, R, A., "Autonomous Manipulation on a Robot: Summary of 

Manipulator Software Functions", Jet Propulsion Laboratory 



■ 67^ 

Technical Memorandum 33-679, March 1974, 

tLiebcrman75] 

Lieberman, L. L, Wesley, MA, "AUTOPASS: A Very High Level 
Programming Language for Mechanical Assembler Systems", IBM 
Research Report RC 3599, August, 1975. 

[Lazano76| 

Lozano-Perer, T, Xfae Dfcsifcn of a Mechanical Assembly System, 
MIT Artificial Intelligence Laboratory Technical Report 397, 1976, 

[Lozano7&] 

Lozano-Perei, T. f and Wesley, M. A., "An Algorithm for Planning 
Collision-Free Paths Amongst Polyhedral Obstacles". IBM Research 
Report RC 7171, June, 197*. 

[Minsky72] 

Minsky, M-, Manipulator Design Vignettes. MlT Artificial 
Intelligence Laboratory Memo 267, October, 1972, 

lNakano74] 

Nagano, E., Ozaki, S-, Ishida, T., and K.ato, I.. "Cooperatiorial 
control of the Anthropomorphous Manipulator T Mela.rm ,n , 
Proceed tnES, 4lh International Symposium on Industrial Robots, 
November 19-21, 1974. 

[Nevins74a] 

Nevins, J, L., and Whitney, D. E,, "The Force Vector Assembler 
Concept", Fjr§r. IFToMM Sympos ium on Theory and Practice of 
Robots and Manipulators. 1974. 



-68 ■ 

[Nevins74b] 

Nevins* I L* Whitney, D, E. t et al, Exploratory Research in 
IridLj^triHl Modular Assembly. Report R-8#V Draper Lab, 

Cambridge, MA, March, 1974, 

[NtTJn$74£] 

Nevins, J, L, Whitney, D. E. p and Wood in, A. E,, "A Scientific 
Approach to (he De&ign of Computer Con trolled Manipulators 1 ', 
Report R-837, Draper Lab, Cambridge, MA, August, 1?74. 

[Nevins75a] 

Nevins, J. L, t and Whitney, D. E. s "Adaptabte'Programmabk 
Assembly Systems an Information and Control Problem"* 
Proceedings. 5th International Symposium on Industrial Robots. 
September, 197J r 

[Nevjns75b) 

Nevins, J. L, Whitney, D. E. + et. aL, "EjpWaiory Research in 
Industrial Modular Assembly," R-«l, The Charles Start Draper 
Laboratory* [riC. T October 21, 1975. 

[Nevins77] 

Nevins, J. L. T and Whitney, D. E, a "Research on Advanced 
Assembly Automation", Computer. December, 1977. 

[Paul?2] 

Paul, R. T "Modelling, Trajectory Calculation and Servoing of a 
Computer Controlled Arm", Stanford Artificial Intelligence 
Laboratory Memo AIM477, November 1972. 



69 



tPaul75] 

Paul t R., "Manipulator Path Control", Proceedings 1975 

International Conference on Cybernetics and Society. 197S. 

[Paul 7 6) 

Paul, &n and Shimano, D + "Compliance and Control", Proceedings, 
1976 Joint Automatic Control Conference, 1 976- 



[PieperbS] 

Fieper, D. L., "The Kinematics of Manipulators Under Computer 
Control", Stanford Artificial Intelligence Memo No. 72, October, 

1968. 

[Raibcrt77j 

Raibert, M, H. t Motor Control and Lcamiim by, the State Space 

Model, MIT Artificial Intelligence Laboratory Technical Report No. 
4:19, September, 1977. 

[Shimano77] 

Shi mane, B. E., "Force Control", Exploratory Study of Computer 
Integrate d Assembly Systems, Binford, T. 0., et aU Stanford 
Artificial Intelligence Laboratory Memo 2.85.4, June 1977. 

[Sih*r73J 

Silver, D., "The Little Robot System", MIT Artificial Intelligence 

Laboratory Memo No. 273, January, 1973. 

[Simunovic75] 

Simunovlc, S. N. + "Force Information in Assembly Processes", 
Proceedings 5th Internation al Symposium on Ind ustrial Robots 



-7Q- 

September 22-24* 1975. 

(Simunovjc76] 

Siwunovic, S. N„ Task Descriptors for Automated Assembly : M, S. 
Thesis, MIT Department of Mechanical Engineering, January, 1976. 

[Takas*74] 

Takase, K., Inoue, H. p Sato, K., and Hagiwara, 5., The Design of 

an Articulated Manipulator with Torque Control Ability", 
Proceedings, 4th International Symposium on Industrial Robots. 
J 9*2 1 November, 1974. 

[Tay]or7GJ 

Taylor, R r H, p *A Synthesis of Manipulator Control Programs from 
Task-Level Specifications", Stanford Artificial Intelligence Memo 
211, July, 1 976 

[Taylor77] 

Taylor, R. H. p "Planning and Execution of Straight-line Manipulator 
Trajectories'^ IBM Research Report RC-6657, July 25, 1977. 

[Udupa77] 

Udupa, S t Collision Detection and Avoidance in Computer 
Controlled, Manipulators, California Institute of Technology FhD 
Thesis, 1977, 

[Uicker64] 

Uicker, J. J, Dena rit, J., and Hartenberg, R. S., "An Iterative 
Method for the Displacement Analysis of Spatial Mechanisms", 
Jojirnal of Applied Mathematics. Tr ansactions of the ASME. June, 



- 71 - 

1964, 

[W;itson75] 

Watson, F. C„ and Drake, S. H., ''Pedestal and Wrist Force Sensors 

far Automatic Assembly", Proceedings 5th International Symposium 
on Industrial Robots. September 22-24, 1975. 

[Whitney 69] 

Whitney, D. C, "Resolved Motion Rate Control of Manipulators 
and Human Prostheses", IEEE Transactions on Ma n-Machine 
Systems, vol. MMS-JO, no, 2 t June, 1969 

[Whitney 72] 

Whitney, D. E., N The Mathematics of Coordinated Control of 

Prostheses and Manipulators", AjME Journal of Dynamic Systems,, 
Measurement, and Control, December, 1972. 

TWhitney7ol 

Whitney, D. E.» "Force feedback Control of Manipulator Fine 
Motions," Proceedings, J976 Joint Automatic Control Conference . 

[Will75} 

Will, P. M., and Grossman, D. D. t "An Experimental System for 

Computer Controlled Mechanical Assembly," IEEE Transactions on 
Computers , vol. c-24, no. % September, 1 775- 

[Young78) 

Young h K. D. t "Controller Design for a Manipulator Using Theory 
of Variable Structure Systems' 1 , IEEE Transactions oil Systems, 
Mail, and CjitjeHietics, vol. SMC-B, fio, 2, February, 1978. 



